package com.yc.tools;

/**
 * author: yc
 * description: 百度坐标，火星坐标和WGS84之间互转
 * date: 2022/1/4 15:44
 */
public class LonlatConver {

/*    public static void main(String[] args) {
        Double lat = 121.368383;
        Double lon = 31.236216;
        double[] doubleArr1 = wgs84_To_Gcj02(lat, lon);
        System.out.println(doubleArr1[0]+"===="+doubleArr1[1]);
        double[] doubleArr = gcj02_To_Bd09(doubleArr1[0], doubleArr1[1]);
//        double[] doubleArr = gcj02_To_Bd09(lat, lon);
        System.out.println(doubleArr[0]+"===="+doubleArr[1]);
    }*/

    /**
     * a
     */
    public final static double a = 6378245.0;
    /**
     * ee
     */
    public final static double ee = 0.00669342162296594323;

    //圆周率 GCJ_02_To_WGS_84
    public final static double pi = 3.1415926535897932384626;
    /**
     * @Description WGS84 to 火星坐标系 (GCJ-02)
     * @param lon  经度
     * @param lat  纬度
     * @return
     */
    public static double[] wgs84_To_Gcj02(double lon, double lat) {
        if (outOfChina(lat, lon)) {
            return null;
        }
        double dLat = transformLat(lon - 105.0, lat - 35.0);
        double dLon = transformLon(lon - 105.0, lat - 35.0);
        double radLat = lat / 180.0 * pi;
        double magic = Math.sin(radLat);
        magic = 1 - ee * magic * magic;
        double sqrtMagic = Math.sqrt(magic);
        dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
        dLon = (dLon * 180.0) / (a / sqrtMagic * Math.cos(radLat) * pi);
        double mgLat = lat + dLat;
        double mgLon = lon + dLon;
        return new double[] { mgLon, mgLat };
    }

    /**
     * @Description 火星坐标系 (GCJ-02) to WGS84
     * @param lon
     * @param lat
     * @return
     */
    public static double[] gcj02_To_Wgs84(double lon, double lat) {
        double[] gps = transform(lat, lon);
        double lontitude = lon * 2 - gps[1];
        double latitude = lat * 2 - gps[0];
        return new double[] { lontitude, latitude };
    }

    /**
     * @Description 火星坐标系 (GCJ-02) to 百度坐标系 (BD-09)
     * @param gg_lon
     * @param gg_lat
     * @return
     */
    public static double[] gcj02_To_Bd09(double gg_lon, double gg_lat) {
        double x = gg_lon, y = gg_lat;
        double z = Math.sqrt(x * x + y * y) + 0.00002 * Math.sin(y * pi);
        double theta = Math.atan2(y, x) + 0.000003 * Math.cos(x * pi);
        double bd_lon = z * Math.cos(theta) + 0.0065;
        double bd_lat = z * Math.sin(theta) + 0.006;
        return new double[] { bd_lon, bd_lat };
    }

    /**
     * @Description 百度坐标系 (BD-09) to 火星坐标系 (GCJ-02)
     * @param bd_lon
     * @param bd_lat
     * @return
     */
    public static double[] bd09_To_Gcj02(double bd_lon, double bd_lat) {
        double x = bd_lon - 0.0065, y = bd_lat - 0.006;
        double z = Math.sqrt(x * x + y * y) - 0.00002 * Math.sin(y * pi);
        double theta = Math.atan2(y, x) - 0.000003 * Math.cos(x * pi);
        double gg_lon = z * Math.cos(theta);
        double gg_lat = z * Math.sin(theta);
        return new double[] { gg_lon, gg_lat };
    }
    /**
     * @Description 百度坐标系 (BD-09) to WGS84
     * @param bd_lat
     * @param bd_lon
     * @return
     */
    public static double[] bd09_To_Wgs84(double bd_lon,double bd_lat) {

        double[] gcj02 = LonlatConver.bd09_To_Gcj02(bd_lon, bd_lat);
        double[] map84 = LonlatConver.gcj02_To_Wgs84(gcj02[0], gcj02[1]);
        return map84;

    }

    /**
     * @Description 判断是否在中国范围内
     * @param lat
     * @param lon
     * @return
     */
    public static boolean outOfChina(double lat, double lon) {
        if (lon < 72.004 || lon > 137.8347)
            return true;
        if (lat < 0.8293 || lat > 55.8271)
            return true;
        return false;
    }

    /**
     * @Description transform
     * @param lat
     * @param lon
     * @return
     */
    private static double[] transform(double lat, double lon) {
        if (outOfChina(lat, lon)) {
            return new double[] { lat, lon };
        }
        double dLat = transformLat(lon - 105.0, lat - 35.0);
        double dLon = transformLon(lon - 105.0, lat - 35.0);
        double radLat = lat / 180.0 * pi;
        double magic = Math.sin(radLat);
        magic = 1 - ee * magic * magic;
        double sqrtMagic = Math.sqrt(magic);
        dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
        dLon = (dLon * 180.0) / (a / sqrtMagic * Math.cos(radLat) * pi);
        double mgLat = lat + dLat;
        double mgLon = lon + dLon;
        return new double[] { mgLat, mgLon };
    }

    /**
     * @Description transformLat
     * @param x
     * @param y
     * @return
     */
    private static double transformLat(double x, double y) {
        double ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y
                + 0.2 * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(y * pi) + 40.0 * Math.sin(y / 3.0 * pi)) * 2.0 / 3.0;
        ret += (160.0 * Math.sin(y / 12.0 * pi) + 320 * Math.sin(y * pi / 30.0)) * 2.0 / 3.0;
        return ret;
    }

    /**
     * @Description transformLon
     * @param x
     * @param y
     * @return
     */
    public static double transformLon(double x, double y) {
        double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1
                * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(x * pi) + 40.0 * Math.sin(x / 3.0 * pi)) * 2.0 / 3.0;
        ret += (150.0 * Math.sin(x / 12.0 * pi) + 300.0 * Math.sin(x / 30.0
                * pi)) * 2.0 / 3.0;
        return ret;
    }

    /**
     * GPS经纬度转换为 度（3114.1717,12122.1067 → 121.37300779，31.23436014）
     * @param dms 坐标
     * @param type 坐标类型  E/N
     * @return String 解析后的经纬度
     */
    public static String gpsToWgs84(String dms, String type) {
        if (dms == null || dms.equals("")) {
            return "0.0";
        }
        double result = 0.0D;
        String temp = "";

        if (type.equals("E")) {//经度
            String e1 = dms.substring(0, 3);//截取3位数字，经度共3位，最多180度
            //经度是一伦敦为点作南北两极的线为0度,所有往西和往东各180度
            String e2 = dms.substring(3, dms.length());//需要运算的小数

            result = Double.parseDouble(e1);
/*            System.out.println("e2===="+e2);
            System.out.println("===="+Double.parseDouble(e2) / 60.0D);*/
            result += (Double.parseDouble(e2) / 60.0D);
            temp = String.valueOf(result);
            if (temp.length() > 11) {
                temp = e1 + temp.substring(temp.indexOf("."), 11);
            }
        } else if (type.equals("N")) {        //纬度，纬度是以赤道为基准,相当于把地球分两半,两个半球面上的点和平面夹角0~90度
            String n1 = dms.substring(0, 2);//截取2位，纬度共2位，最多90度
            String n2 = dms.substring(2, dms.length());

            result = Double.parseDouble(n1);
/*            System.out.println("n2===="+n2);
            System.out.println("===="+Double.parseDouble(n2) / 60.0D);*/
            result += Double.parseDouble(n2) / 60.0D;
            temp = String.valueOf(result);
            if (temp.length() > 10) {
                temp = n1 + temp.substring(temp.indexOf("."), 10);
            }
        }
        return temp;
    }

    public static void main(String[] args) {
        //示例：
        //百度坐标 121.539766,            31.302119
        //火星坐标 121.533291323438,      31.296084964573257
        //百度坐标 121.53976599380911,    31.302119029166427
        //大地坐标 121.52896963953575,    31.298170624136127
        //百度坐标 121.53330528880366,    31.296097084382737
        //尽量不要转，转换太多造成的误差 可能比 各个坐标系之间的偏差更大
        //百度 - 火星 - 大地 转换误差依次变大
        double[] gcjo2 = bd09_To_Gcj02(121.539766, 31.302119);//百度 --> gcjo2(高德/腾讯/火星)
        System.out.println("gcjo2:" + gcjo2[0] + "," + gcjo2[1]);//121.533291323438,31.296084964573257
        double[] baiduFromGcjo2 = gcj02_To_Bd09(121.533291323438, 31.296084964573257);
        System.out.println("baiduFromGcjo2:" + baiduFromGcjo2[0] + "," + baiduFromGcjo2[1]);//121.52896963953575,31.298170624136127
        double[] map84 = bd09_To_Wgs84(121.539766, 31.302119);
        System.out.println("map84:" + map84[0] + "," + map84[1]);//121.52896963953575,31.298170624136127
        double[] baidu = wgs84_To_Gcj02(121.52896963953575, 31.298170624136127);
        System.out.println("baidu:" + baidu[0] + "," + baidu[1]);//121.53330528880366,31.296097084382737
    }

}
